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1, INTRODUCTION 

A precise dynamic model of the system to be tested must be formulated to design a high performance 
controller. Its parameters should be equally precisely identified. Furthermore applies to industrial robots. in 
that event, the problem of identification becomes especially complex because of the presence of nonlinearities 
and coupling effects, typical of robotic systems, by dint of the inertial, friction torques, gravity, centripetal and 
friction torques [4]. 

The presence of a fault can be modeled as an unexpected change in system parameters or by the 
presence of unknown signals in the industry. In a robot manipulator, a fault be able to occur on a actuator, a 
sensor or a mechanical component of the system. specific Actuator and sensor faults are more common thanks 
to the presence of electrical devices, which possibly be subject for a lot of possible criticality. 

Diagnostic devices generate on-line diagnostic signals in order to detect and isolate the presence of 
fault. Specific methods considered to surmount this disadvantage, as like the use of Kalman filters [6], or gen- 
eralized moments, see [8]. These approaches, in the presence of typical uncertainties of applied applications, 
can not have the possibility exactly to converge from the state of the system to the state of the observer. To 
minimize this drawback, sliding mode techniques are also frequently adopted to perform status observation 
[10, 11] owing to their simplicity of design and robustness. Usually, the FDI can be treat by incorporating 
various sliding mode observers [12, 13]. 

The aim of this paper is to study the performance in terms of the robustness and diagnostic capabilities 
of sliding-mode input law for the observer. specifically , second-order sliding mode (SOSM) law, the super- 
twisting law [17] 1s considered. The diagnostic technique proposed in this work proves to be capable to detect 
non-simultaneous sensor and actuator faults, specially for actuator. 
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2. THE MANIPULATOR MODEL 
The equations of motion of an n Degree of Fredeem (DOF) robot manipulators are described accord- 
ing to the Euler-Lagrange theory, as: 


T= M(g)G+C(a,g)a+G@+F@) =M@dt+na9) (1) 
where q, G, d € R” are the joint position, velocity and acceleration vectors, respectively, M(q) € R‘’*”) is the 
inertia matrix (symmetrical definite positive, thus, M/(q)~! always exists), C(q, @) € R'”*™ is the centrifugal 
and Coriolis matrix, G(q) € R” is the gravitational vector, F'(q) € R” is the vector of viscous friction torque 
at the joints. Now, introducing the variables x(t) = q(t), x2(t) = q(t), model | can be rewritten in state space 
representation as: 


L1 (t) = V2 (t) 
to(t) = f(r(t), e1(¢), ea(¢)) (2) 
h(t) = a1 (t) 


Where the term f(7(t), 71(t), x2(t)) is obtained after simple algebric manipulation of (1), i.e., 
f(r(t), 21(t), za(t)) = M~*(x1(t)) (T(t) — n(x1(t), v2(t))) (3) 


As previously mentioned, when faults affect the actuators, the input torque for the mechanical system is differ- 
ent from 7(t). Then, in case of input faults, (1) becomes: 


T(t) + Ar(t) = M(a21(t))to(t) + n(x (t), 2(t)) (4) 
and, as a result, the state space representation 1s: 


X(t) 


t 


£1 ( ) = £2 
t2(t) = f(r(t) + Ar(t), v1 (0), v(t) (5) 
q(t) = x1(t) 


where f(7(t) + Ar(t), x1(t), x2(t)) is analogous to (3). In practice, model (3) is not exactly known 
and must be identified. Then, in case of faults, the following relationship holds. 


ee x(t), ©2(t)) = M~*(ar(t))(r(t)+ 
Ar(t) — n(wi(t), a(t) — n(#)) 

n(t) = n(xi(t), wo(t)) — n(ar(t), v2(t)) (7) 
When 77(t) is uncertain and n(q, G) is the known part of the model. Yet, by virtue of the particular application 
considered, 7)(¢) can be assumed to be bounded. Obviously, to perform fault diagnosis, one has to rely only on 


the known part of model (3). Indeed, after a suitable identification procedure, such as the one proposed in [19], 
it is feasible (in absence of faults) to determine only an approximated representation of f(.), ie. 


(6) 


f(r (t), 21 (t), 2(t)) = M~*(21(4))(r(¢) — A((x1 4), e2(C)) (8) 


in order that the actually usable model is: 


in (1) = a2(2) 
in(t) = f(r(t), er(), e2(8)) ) 
a(t) = «i(t) 


3. THE PROPOSED DIAGNOSTIC SCHEME 

By relying on the so-called Unknown Input Observer (UIO) approach [11], efficient estimators of 
the input torques can be designed [21]. In this work, the UIJOs of sliding mode type is proposed in order to 
detect the actuator faults. The proposed UIOs can be jointly described as a multi-input-multi-state second order 
sliding mode observers. 
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3.1. Observer Design 
Let us consider the observer: 


en fta(t) + z(t) 
#o(t) = f(r(t), x1(t), €2(t)) + z2(t) 


where #,(t), #2(t) € R°” are the observer states, and z(t) = [z1(t), zo(t)]T is an auxiliary input signal, which 
is designed relying on the sliding mode approach, as will be clarified. This signal is introduced so as to permit 
and guarantee the convergence of the observer states to the actual state of the system. Each component of z(t) 
is an input law of the observer. 


(10) 


3.2. Dynamics of the Observer Error 
The proposed fault diagnostic scheme requires to steer to zero the signal e(t) = [e;(t), e2(t)|7 € R°” 
, the components of which are given by: 


ie =27i() =o (11) 


€9 (t) = L9 (t) = X92 (t) 
By steering to zero these quantities, it is possible to guarantee that the observer (10) gives a good estimation of 


the unknown input, as it will be shown in the following. 
The dynamics of the error variable e(t) is represented by a second order dynamical system: 


é€1(t) = €9 (t) ae 25 | (t) . 
éa(t) = f(r(t), v(t), ea(t)) — Fr) + (12) 
Ar(t), 1(t), @2(t)) — za(t) 


which can be rewritten as: 
ies =ex(t) — alt) ae; 
éa(t) = M~*(ax1(t)) — (Ar(t) — n(t)) — 2a(€) 


Now, Second Order Sliding Mode approach is studied to design the multi-input-multi-state UIO input law. This 
approach is the so-called Super-Twisting [17]. The proposal will be depicted in the next subsections. 


3.3. Super-Twisting based Observer 


The design of the observer input laws which are the components of z(t) = [z1(t), z(t)]* using a 
Super-Twisting based approach (see [17]) is given by: 
A(t) =a Peng Mee) (14) 
Zo(t) = asing(s/(t)) 


Where s/(t) = e1(t) = x1(t) — &1(t). It can be proved that a suitable choice of A and a exists such that, 
starting from any initial condition [e; (0), e2(0)]7, the condition: 


e1(t) = 0 
a =0 vee 


is guaranteed in finite time (the proof of this claim can be developed as in [14]). To implement the proposed 
method, the terms a and \ have been chosen after an experimental tuning procedure. Note that the term z2(t) 
is a discontinuous signal and, by virtue of the filtering action considered in [22], the second equation of the 
system (13) can be rewritten as: 


22eq(t) = M~*(xa(t))(Ar(t) — n(¢)) (16) 


where Z2eq(t) is the equivalent input signal corresponding to the discontinuous signal z2(t). Thus, theoret- 
ically, the equivalent input signal is the result of an infinite switching frequency of the discontinuous term 
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asing(s/(t)). In fact, the implementation of the observer produces high switching frequency (since, in prac- 
tice, one can only implement z(t) as in (14) and not z2-,(t)) making necessary the application of a filter to 
obtain useful information from signal z2(t). The filter has to eliminate the high frequency components of such 
a signal. It can be of the form: 


Dzeq(t) + Zeq(t) = 22(t). (17) 
Indeed, in [25], it was shown that : 
lim Zeg(t) = Z2eq(t) (18) 
p—O0 


Then, by taking a small p it is possible to assume that the equivalent input law (16) is similar to the output of 
the filter. 


4. THE CONSIDERED FAULT SCENARIOS 

In this work, the occurrences of faults on inputs of a robot manipulator is considered. In this situation, 
the real torque applied by the actuators is unknown. That is, 7 € R” being the nominal torque calculated by 
the robot controller, while Av € R” being the input fault, the actual torque vector which is the input of the 
robotic system, can be written as T(t) = T(t) + Ar(t) as shown in Figure 1. 


Fault 
Alarme 





Figure 1. The proposed FDI scheme for actuator faults 


5. RESIDUAL GENERATION 
Error of the state estimation r(t) can be calculated as: 
(j= Fb)—7@) (19) 


The residuals are supposed to differ from zero in the present of faults (r(¢) #4 0) and to be zero when there are 
no faults on the actuators (r(t) = 0). So the residuals are defined as: 
=F 


rt) =0 if T 
20 
loos iF Tae — 


Table I represents the fault signatures matrix for these residuals. We find that the signatures for each of the 
failures are quite different. 


Table 1. Signature Table for Actuator Fault Isolation 
di/r, T1 72 73 T4715 


dy I 0 0 0 0 
do 0 1 0 0 0 
d3 0 0 | 0 0 
da 0 0 0 1 0 
ds 0 0 0 0 1 


6. SIMULATION RESULTS 
In this section, the performances of the proposed FDI scheme for robot manipulators are verified, 
by simulating actuator faults. To carry out simulations, the model (5) has been simulated together with the 
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observer (10) with the input laws (14) relevant to the Super-Twisting approach. The presence of actuator faults 
AT is simulated by introducing an abrut fault signal on the different articulation of the robot (joint 1, 2, 3, 4, 5, 
respectively). The simulation shows fault detection and isolation for the five articulations of robot manipulators. 
Detection and isolation of the faults for actuators (Av and A7 signals) by using the Super-Twisting input law. 
Figures 2, 3, 4, 5, 6 presents two signals, one for the actual states and the other for the estimated states. Figures 
are simulated during the time of 7’ = 10s. The kind of fault is ’Abrut’. the difference between the two signals 
gives a residual for each joint of the system. 


Figure (b) in figures 2, 3, 4, 5, 6 shows an observation error between the actual states and the estimated 
states. Residuals for all articulations are different from each other and react according to signature table for 
actuator fault isolation. The fault is appeared at the time t = 3s. 


This methods gives a good results in comparison between the original state and the state estimate, 
therefore the state estimate converges to the actual state rapidly, that’s why we find the residuals equal to zero. 
So this proposed technique detect and isolate the actuator faults in a robot manipulator. 
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(a) Fault signal reconstruction (b) Residual signal for the first actuator 


Figure 2. Simulation of FDI on the first actuator (Av and A7 signals). Detection and isolation of the faults 
by using the Super-Twisting input law. 





















































(a) Fault signal reconstruction (b) Residual signal for the second actuator 


Figure 3. Simulation of FDI on the second actuator (A7v and A7 signals). Detection and isolation of the faults 
by using the Super-Twisting input law. 












































(a) Fault signal reconstruction (b) Residual signal for the third actuator 


Figure 4. Simulation of FDI on the third actuator (Av and A7 signals). Detection and isolation of the faults 
by using the Super-Twisting input law. 
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Time lacus : Time (seconds) 
(a) Fault signal reconstruction (b) Residual signal for the fourth actuator 


Figure 5. Simulation of FDI on the fourth actuator (Av and A7 signals). Detection and isolation of the faults 
by using the Super-Twisting input law. 
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Time (seconds) Time (seconds) 


(a) Fault signal reconstruction (b) Residual signal for the five actuator 


Figure 6. Simulation of FDI on the five actuator (Av and A7 signals). Detection and isolation of the faults by 
using the Super-Twisting input law. 


7. CONCLUSION 


The problem of fault detection and isolation on a robot manipulator has been addressed. The presence 
of fault detection is performed depending on higher order sliding mode Unknown Input Observers (UIOs). 
The observer input laws are designed by the so called Super-Twisting Second Order Sliding Mode Control 
(SOSMC). The proposed scheme allows one to detect and isolate faults, even multiple and simultaneous, on 
the actuators of the robotic system. Simulations are presented proves The effectiveness and the performance of 
the proposed technique. 
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